#ifndef __MY_MATH_H
#define __MY_MATH_H



#include "app_include.h"

float constrain(float amt, float low, float high);
int32_t constrain_int32(int32_t amt, int32_t low, int32_t high);
int16_t constrain_int16(int16_t amt, int16_t low, int16_t high);
float Deathzoom(float input,float center,float width);
float Ramp(float input,float target,float step);
void KalmanCreate(extKalman_t *p,float T_Q,float T_R);
float KalmanFilter(extKalman_t* p,float dat);

#endif


